/*
 * Magnetometer.c
 *
 *  Created on: Jun 15, 2024
 *      Author: admin
 */
#include <stdio.h>
#include <math.h>


float Magnetometer(float Bx,float By,float Bz)

{
    // 计算磁场矢量的大小
	//float Mag_B = sqrt(Bx*Bx + By*By + Bz*Bz);
    // 计算水平方向的角度θ（与北向的夹角）
	float Mag_theta = atan2(By, Bx) * 180.0 / M_PI; // 将弧度转换为度
    // 计算垂直方向的角度φ（与水平面的夹角）
	//float Mag_phi = acos(Bz / Mag_B) * 180.0 / M_PI; // 将弧度转换为度
	printf("YAW: %d\n",(int)Mag_theta);
    return Mag_theta;
}


